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(54) Title: GAIT PATTERN GENERATING DEVICE FOR LEGGED MOBILE ROBOT 

(54) *^<7)*W: NA»na7R^'ha>»8&AttB 



(57) Abstract: A legged mobile robot, 
particularly, a biped robot, wherein a dynamic 
model showing the relation between the motion 
of an upper body and a leg part and a floor 
reaction is provided, the parameters of gait 
patterns including the parameters determining 
the routes of the leg part are determined 
temporarily, the parameters of cyclic gait patterns 
followed by the gait patterns are estimated, the 
parameters of the gait patterns are corrected 
so that the routes of the upper body determined 
based on the dynamic model and the parameters 
of the gait patterns are converged to the routes 
of the upper body determined by the parameters 
of the cyclic gait patterns, and the instantaneous 
values of the gait parameters are determined 
based on the corrected parameters, whereby 
the gait patterns such as any step, turning angle, 
and walking frequency can be generated by 
generating freely and in real time the gait patterns 
including the floor reaction while meeting the 
requirements for dynamic equilibrium, the gait 
patterns allowing the continuous displacement 
and speed of each portion of the robot and a 
high allowance of stability can be generated 
in the boundaries between the generated gait 
patterns, and the gait patterns can be generated 
by predicting the future behavior of the robot so 
that an inconvenience such as an uncontrollable 
attitude is not produced. 
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. 1 2|i, ZMPpend #^i&UT&p[k] «5§SH2-f> l^nttZMPBiaxtZMPminCD 

Sf*#3tUT N ZMPpend ^fe«M£(Hk — )£fl[ZlIPOC:nc«#^*# 
l:§tttt;t^t?i«, cn«> p[k] *©tDH*K:^*>sr^ ZMPOfc: 
p[k]=exp(- CO Ok At)*(p[0]-ZMPO)+ZMPO 

• • • &1 8 

ZMPpend »7^^SI^— ZMPpend Kit fe^tfeitlcJR 



n # £ m m <mm) 
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^tbts ZMPpend rt<&3l$j£Us(I^ -£mHP0K:tt5#££#;l£ o C 
©&£\ ~^ISZMP0(cnj:S^^5fcJ6T^SII0 t-TSt. &*C7(i % &sU At 
tttK cni4> q[0] - ZMPO T?l*/j:v>IE(K q [k] ZMPO^^ifcSffrftt:: 

q[k]=exp(coOkAt) * (q[0]- ZMPO) 4- ZMPO 

* • • £fc l 4 

-E-C-e. E*P^ &5$5K<}:-,TJig^3*i3p Ck] £JR3iCJ&3\ q Ck] £ r 
J t»?^o 

<fc£ attune ti, 36««^**tf«=3£l»*^ttffl <Mfttt^46B 

mm i : st^ft 

•iRSJft^P Ck] q [k] £Jfci6£5e<Z>gWi> p Ck] tq Ck 

A^]ZMPpend[i]t UT. ZMPpend[0] = U0 fc N ZMPpend[i]=0 (i =1.2....) 
7?§^sn*'«;U*£it;i£^ -e<Z>t£<Dq Ck] »i % 7 \Z z ©ZMPpend [ 
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q[k]=e?q)(a)0k At)(q[0]+(ej{p(- 0)0 At)- 1)U0) 

• • • SS: l 5 

C*lJ;!K 8®c/ifc#q Ck] fc. fgj«/<^XO0*A 

UO * (expC- 6)0 At) - 1) 1£\tW&1Mta&&*-f C fc 
b^@«-#^«o fiP"&. 8J»5^xli> Cexp(-a)OAt) - 1) te-fsc: fcicJ:^ 

A#ZMPpend[i](i=0.1.2....k-l) £A2J-f£ cil*. &s$ 

k-1 

OD= £ (e3q>(-a)0iAt)*ZMPpendIlD 

i=0 ^, , _ 

•EPS*. A^ZMPpendti ] 0=0. 1,2.... k-1) it, 1 6{CJ;oT. WW*** 
A*UOtC^fiB{m#^n^o 

£/c. SMHCa^J:-^ ZMPpeDd[i]*<fc*W»fa)'r**K ZMPpend' [i] 
WtemCiy&Wffln A ttctfMZtt&WLtti- nAt)TNfc3fcU A^JflZMPpen 
d[i]*»*B'<^:*i::Se!fcUfcfc©*UO, A^ZMPpend' [i] ^aHH'WXir^Jfe 
tfc^O^UO* fcf 5^ UO' (*«5$1 7©«fc5Ktt<5o 

UO' =UO*exp(— no) 0 At) 

• ■ - " • • - Jfcl 7 

Ep-fe^ jJSBOA^^SnA t Afita^TA*^ * *<Z>A*C«fc-3 

RV*T?n ^ 5 E^^-r^SC^^T 5 ^^ ««ttll3aSHPZMPSJB£A2jb 
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#*&*l£ZMPA:*)«\ EfRZMPfcmtotal/mb tcmWibtobs MZMPlz 
&£<D*^ g^ZMPKmtotal/rab #-^12*: *>© * tebVrtim®&&-e&Z 

o 

&*z&ik&ft%m9rto{z#fyzmmbT)^*)x&£w,wi-Zo pzmp 

5g£H C7fc¥M-fc) £#S&f&# N ^T^^i&TI^ a»(0*BoySiJ6H 1 &tg 
^M^OZWP (ZMPpend ) Sitltil 0 0fw^-r«}; 5 Wti^*JK^ 
t-TSo COZMP{CJ:-pT^-rS5l®:^^a6SfcJ6(DmstT^=ruX 
. !§!:SfcS^7^C|if:S^ZMPA#il/T\ x«f(t)jW*!MeH [O.T] © 

w \Ji % nfccti:j;o -t sg£-r s >»«r o ka^ s *is mmm-^n 

T/At-1 

H(fCt),T)= £ (kAt)exp(-a)kAt) 
k=0 

• ■ -SU 8 

x=f(t)= 1 ©X-f y^»3B©HCf(t).T) a(l.T)iW5t, 
H(1.T)=(1 -exp(~ co t)) / (1 - exp(- a> At)) 

• ■'• ttl 9 

mm i mm mm) 
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x=f(t)=t©5V:7&i*©HCf(t).T) *H(t.T)tlB«1-*t. &5$2 OK^ • 

H(t,T)/T=( AVT*exp(- Q) A.t)H(l,T)-exp(- 6)t)) / (1 -exp(- CO At)) 

• • -&2 0 

J:IBW©Ht!i:f t?«s *Wf¥F(f(0,T) tffffeUcv^&fcfc*;^ *©RgK 
tts W#f *2E«MtUC*€s HCf(0,T)&T— ^{fc-rn«a^ 0 ±B« 
•CfeFCfCO.T) ^f-^fbll^m^ 

t©l££g^ZMP^V!/;*©:*£$fc&g:i,/cfc© cn*WtEt)' * 

£-f> Eur i o=o. l. -aaiss^zMPoM^ gin i ©aijawwicA 
eis i om&m^zMpmmt, mi ircs**-^^ ig&awt 

i]©jeJB»t«^^CZMP[i+l]-ZMP[i])/periodCi] ©5 ^^ttOflnJ^fo^ft* 
©*e> '<*x£mK itmSi 2 l fcj*** J: 5 izfc *• 

• ijQf[i]=HCl, period[i])*ZMP[iJ+-H(t, periodji]) / period|i] *(ZMP[B-1] -ZMP[i]) 

• • • I&2 1 

ft^T?. E(Speriod[i] Ci=0. 1,.., iii)O«I4I?ZMP0»#^ Bi^JOfc: 
A*3*i3^VI/;*T?;&-pT n <e-©B$m#<#&l¥IBiA t ©/>Vl/^©^'g§inf [i 

1-1 

inf^i]=mf[i]*exp(--coO( X periodfk])) 
01 O0K^iTM:£ig^ZMPi«£KIS©S£#l*. &EI1B©«:£II-?ZMP 



& tt * JS « 
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o 

W= £ inf '[i] 

i=0 

• • • #£2 3 

5$ 2 4 (r^-Tfilic/j^o 
W*(exp(-coOAt)-l) 

• • • SC2 4 

s k^2 4 ^fctafiir 3 io N cn*^*iwso-e©^iS:iK^{wgi^ 

L;fc&©M:. ^2 5 C^-TttCT^So 

m 

W*(exp(- CO 0 A t)- 1) *exp( co 0( £ periodl!])) 

i=0 

• ■ • lt'2 5 

Jfc#lfci:<D3atfc*ISihU ±{friMJS¥©IS©«®<i:<smW«£lgS£;!c 

#©i££$m(c#a&3av-e&.5c, . 
c: om&ommzm i o on. <^£j£f s^k-d^s^s 

o o ©Rift £fMm- t&9i-r §o 



it^.«iK era a) 
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<$-®$:nmmm&iz— wet &<> &&&miz&\,*x& 
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6 0 8 l^&tRCBtt) ) o fc/fU 4lsI^0ZMP«ltit^5^-^{d:, 

So 



WO 02/40224 



32 



PCT/JP01/1002« 



o 

C tl &(Oli««-m 1 3 HfcjjrTo 

^^-i'f^bT, gag©&# (Sift*-* (T^faX-^) <2>&J££<ft$ 
» 1 ft®***? J: Cf «f 2 ZMP «4i@v< 5 ^ - * & , ft£*tt*<A < 

5 0 J£*&* ?JU£m V *T JtiB* I * 2 tt@^$«^J9ft U SCF 

6 1 «B0*O&S«Rttt« i: *oa»Bifltft«jfttt«aK^ fgf2g*j£ Lit. 

?ufl)!Jb«:ft^tt@«K©itxo. v o {c— gc-r^o CKDttXO, V0«- 
oj:^^/j:s« fc«U X0£ (xo, yo) t*tctiU VOKonxi* 
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-©£■5 ft 5 Hir***tt* i 5 , /l'*JB^T» 1 k®P®b% 2 

ttH0#*2a2El=»«)jSb4feJRbTfe, MJNK2*<**lttfrMK!K ft 1 fig®^ 

©an** cot*©»ft^s xo + vo/ojo <£. r&%m®&®®$)m 

ftl 5Btt. ftl 2®7a-.^ + -hbS2 8 <D^tg@^©SJ|8§g&J^ 
q[k]=e5gj(<w Ok A t)*Q[0] 

k-1 

-+exp(a>OkAt)*(-exp(coOAt)-l) £ exp(-Ci>0 At)*MtotaJ/mb*ZMPtotal[i]) 

i=0 
k-1 

-exp(G> Ok A t)*(-exp(G> 0 A t)- 1) £ exp(-i<i) 0 A t)*mfeet/mb*ZMPfeet[i]) 
. i=0 

• • •»26 

arawc^ssnTu* *>©t ujtirfaufcjrairft 1 figure &ft 2 tua^ 
^afti^i*> sjjHssffiEjK^iwions^-r^^sss:^*^^ =&azft 

2®l^ i«ZMP/<^->JcJ:oT»fe-r*»«»toR^*a*>-ro ^Sft3 



£ # it ft ft 



WO 02/40224 



34 



PCT/JP01/1002* 



3-£#a6S N gfcsSl 9, 20. 21, 22, 23, 2 5 ic^r^m; x/*&m 
^T#?#rWlw#a6S, cn*Wzmptotalt-r*o (X Y^|SI*<*«cd^ Wzmpt 
otall^&Tc'*? h;Mcfc<5o > 

$SKZMPfeetUKi=0.1,-",k) 1 , 2fr£#&. C*v& 

-Lf3©$D< LT*J6 5ftfc^£Wfeett-r.5o (XYW*5©^ Wfeet 
&_LJ:{K &<Z>iS:5$2 

qjk] = exp(oa OkAt) * q[0] 4- Wzmptotal + Wfeet 

• • '»27 

q0O3=q'[k] 

■ • &2 8 
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qPc^Mq'Kl+B 

• • -82 9 

qB50=MqOD]+B 

• ■ • &3 0 

0 £8t5$2 7 J: (3, #C©&5$3 1 &n>Z 0 
MqjjO] + B = exp(oo OkAt) * q[0] -f Wzmptotal + Wfeet 

• • • &3 1 

qfO] = inv(M- exp(<BOkAt)I)(Wzmptotal+ Wfeet- B) 

• ♦ • & 3 2 

^>-es i o 2Kif£<&, &s£2 8©^ia^3®«rm^rJSis±('J:oT^ 

J858&J£#q CO] &3fca6So S^lsISJIK^^q CO 3 (±> 

s i o Bizm&, feftmmwm&wtmfrq. co] ^^m^o^ffii 

t&®&&izts\}%$imi:& £X,£ffibT?fc*©T, «TT?I*> gtfc. -lit, 
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c ®mmotemx\±. ZMPtt^N'^^-^^jE^-scitfr**. -zonk® 

[^air^$a<, ggfZMP (ZMPtotal) =<E@g?ZMP + ZMPtelEg. t 
W2mptotal= Wzmptmp +a * Wtrim 

• • -Si8 8 

3&&j£#-C&5o WtrimWu a « 1 t U/d©£-CDZMP^iEgK: J; o*CJ6£-r 5 

x&&ir%&mma&ft%ifrv>s>'fimz&^x, f?tffftK#i6£*i£o 

&^3S&fi!c#p[k3riV 8fc>£2 7 i&5£3 3«fc0s &©& 

q " = exp(co OkA t) * qJjO] + Wzmptmp + a * Wtrim + Wf eet 

• • -8*3 4 

a = (q^-expCcoOkAt) * qff)]- Wzmptmp-Wfeet)/Wtrim 

• • 5 
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fH 2@7o-.f + -ho^i:^t % ik^vSS 

q" K— S:-r^J;-5fc, /-^*UFjE^*. 

£TFiB9i-r3 £v S 2 0 0 Ic&vvc4liljfr$®ft^8z MP t 
3^?&&ttRftJft&1lfeiiptap«-$a6* &wr*s 2 0 2izm*> a= l 

act^-CS 2 0 4 ^E**cD|l|f*»KJ:^-c»fe^*»JB3Blfe^fc* 
Wfeet**», ^>tS 2 0 6R«^ 4>l§I#$O|0XB38ff[JjK^q [0] Z®M 
«:fc»**fc« *afrfett«ftAS 5lcftALTZMP*tjE£cDfc 

J£i^&a£#a6<5o ^t?S 2 0 8 f=3S#> ffifBLfc J: "5 CI^ZMP ©^'5 ^ 

l£l 2g(7 a- • ^ + - h©ifcl5fK||<5*, ^7S2 0 Kit^ ifc^Sn* 

&TnW?Zt, S 3 0 0C*^t, 4-EJ^&^*-*£g(c, BfMtKfc 

3?^&#adK S3 o etrii^ fc<fc«5$2£m^r> ^Jtfect^'en 

&fif©BlgJl¥&l:£§^^ NFSUt IC^j^-SWZMP (ZMPfeet ) ^Hiti^* 
^S 3 0 8 Kit*, ««3*fflV^ ^jS^ZMP(ZMPpend) ^ffib 

ttits, &^rs 3 1 2 Kit*. «a:«-?* s Fttflb^6±«:©*sFtt**«fcjef 



WO 02/40224 



38 



PCT/JP01/10026 



&^T?S 3 1 4 \zm&, *ffiSA^fC^W¥l 0 - 8 6 0 8 0 *§-&$8Tfit3!S 

-eofdsoa^fi^F i&m fam&m mm > b^^e^j^^ (bp 

6. B^ZMP) Iftit. (flit) I*. &-£:a>?7-fT>X 

Sftf^^sui o Aizmmmznz—^ mmm&j]&m» i o 6ic*>2§£ns * 

«fcO f S^#S3p^^3*t^§nT|g^3^^-YTVXi6#^SBl 0 4 Kit 

&g&§£ (flit) #o,-tf y h$<«Pf**5M/l 0 2Ki££*l£o n'#y MMS** 
TJVi 0 21*. B&Ji#&E£& (Mm bWmMtt&tt S&iEBasmsRfc® 

g& (tftm) &A2}$nsfc> ^ne>^fSjB-rs 1 2iH©&gii (i or cd <t 

) ^SSItUDsKy HOI 2{H©BII5J<0^€fc^it^«!ljai-r'5o 

SB1 0 4ICi££ft6 0 otf-, M iZ§:Vt:g&®®mmeerrx. tferryli 



WO 02/40224 



39 



PCT/JP01/10026 



5 4T>xwjftjkmui 0 4»> A*mzm-4\,*Tsmw&feiEt% e 

®A*«&Kffi®Lfc#lfHM 0 - 2 7 7 9 6 9^£®tt^i::1¥&u:ia$B3ttT^ 
3©*C. i8BJ!£jKJbKihi6* 0 

©*C. #ffi®Art<ftK^glI¥ 1 0 - 8 6 0 8 l#K:fc^TSt&Lfcf£$&©Jhfai, 

frfljH* i?©Np*4i«t« ir&ic, ti1zfr&m±<Dmmz 

o 

BPS. ^1 9Bl*±ftftMC4>Y«K#A (aa&arm) A • 5 s - 

£ fc, <e nc J: o T3*ff £W©I&fl; & U TAt94 u *c£fifc-e g * £ $ left § © 

o 

left*. M*.(*ttA¥4 - 1 5 0 6 8 9&«T«*Sn* lf^f^OTL 

t$>&v> c ±mvtcnm<Dmmz&\,^xmm&£ o \z\stzz k ^ 

«©»f*©— » 1 ©HJ£©J&JIg©& 1 5Bk:B«T^ ^«e@I^ 
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2ommommz$>^x\t. &«tracpu tmiom&mus o) 

K<g!*i (X0, VO) <HR2fe*-r«. -Lttffcgilffili. JbftttS&Ofegfc&K 

Yiga?cD4&5Gfwtt*o 

V^KK^*l8:3eU/:*»3B/X*7 s ^) *J8^*C (X0, YO) <£Jbft:© 

JU*»fcH\ iPZMPfci«SSTO@£g*£i«.kflcg?&£*a&. (X0. 
VO) £±#©30»Ittg£ffi£ U ®A^f^ffl^tIIZMP^£t5 
Jtf*ttflt*&JS"*-*« »l©»»Oj|5»i:|BI«C «UC£jftttMF&jft«IS 1 0 0 

hums c»i 40©x* - . y' - ffi^trati) &$>&timz$mu *o 

(Xe, Ve) b-t So 
ifeV^-CS 4 0 8 Kit*. ®^<D*H < „ (X 0 , V 0 ) b (X e , V e ) ©H ( 
errx.erry ) fcgHJ^So EH*,, %$;mmifc&*e\t (XO, VO) b (Xe, V 
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e) &UTWj*:mtttt&ttv>c4::&N6 > ffisfog (errx.erry ) jJ<ot^ 

K> 8J83&StJ&fr (XO+V 0/6)0) t*U8§JR3?tj&# (XO-VO/wO)^ 
S4 1 O-CS^&ftSir&tiS 4 1 2ir8*. (XO. VO) OtfffircttttCD 

sumftjit (xo+axo, vo) , (xo, vo+avo) -en-en 

fctt (Xe+AXel, Ve+AVel), (Xe+AXe2, Ve+AVe2 
) £#a&3o 

*^tS4 1 4Kii# N (XO, VO) J:^©N-ia©fiJ»||i«l1»{wS«-« 

imtttteiraKiiirBbfcSi^Sfc, &#©to*8te«*& (xo, vo) 

littOiBUfr-:? (S 4 0 2) £&tfTS 4 1 6l^l», £mB&XB£flfcJftg- 

q co] -£s^cD5*;fr£3fca65o #i^-cs4 1 8i:as^ m i <omm<omwiom 
i 5®cds i o 6 tmwmm&ftvo 



1 2BfcR»©7D- • HCfcWCS 3 0 \Z.M** 4»®2fr*cD 

jstTWJI-f £ fc. S 5 0 Q*mxS 5 0 2CB^ <EB^ZMP^*->£:* 
fcPioT4B*«l«tOJ:#ttll« (Xe, Ve) £#a&, 3 
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ifcj£#q [0] *H*©SMrJB^T*a&* 0 
&<^*eS 5 0 4 Kit*, &m%&&&mmrrq&m&<D&.&m^T%:it>, S 5 

5 0 8 1^*. a=Aa tU & 1 ©HJffi©^SStl^«llw^ l eMil^o 

cfcK«fcoT. ^ig^S&jg-eoJtttttgiiK (Xe, Ve)$ 

^ S5 0 S IZ&\,*TA a&mmz&jZ£tl%m^3.<0fe&'C$>Z o 

«k o TmHerrq^/jN^ < ft $ CotiT A a W&1T%> i. \zWCfe LX 

&t^TS 5 l 0Ka§#. '<5*-*®Kr £®^©5£^S:fca6, S 5 l 2 Kit 
li^OlU-^ (S 5 0 0) ZikVTS 5 1 4 iZM^ «&ttK»£nfciRB 

tnmiz* *®&&o&Mm&i£aii<. Mimmtam^n^a co] ^tu^ 

<D^g; i 3 * - * © 4» © B |R Z M P '< * - y trmiEir £ J; o \Z U fc 0 
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vo) T©MM^^=Jbrrv mm^bv ^abxik^o^m^^. 
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( & S t > ti 1 7* A,) ti Z<Z>&M*?;l»$:m<,yT kil^C bitWo £~C&t£ 

ZMP$aEga<o itttu ^HISN&i: 
LT&^SftSStgZMPfcfcs m%.Viz&1$mmtfr®cr> ZMP (fl?BgSZMP) 

^^nsa^zMPmittts^^uiit^^^ <irn> &£&*§*<<B:<tt5 

* £<D 1 3*-Cft JCS- tag* § J; 5 t£&HLtfi!k Utz1%^ Sfrttfr >b 

3Etr^l&$-&^/c86tri^ZMPtlit€-^:t <^ir-r^>-r^*^U 

o 
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3) t4) c: i fcoTg&T?* *K ^^t^«c©^ 

mammon i smim®**^ ^ig®^<DS!icD^«!i^-ri»ig0T^^ 

BJJ^ Ill 2 2@{c^$n<. ^^©^^ih^^tr^^fc^-rsi: 
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# i a>*ffi<Dj$ttfr 3 onm®wmt±fc<oia < . < t *>±.w 2 At 

mm%k> Vtik®i£®%&mmmx, <$®&&m$is ikm^mmtito S2 2) 
mix taiaiM©#tii: <B«£¥ifcB«&«ug) titria^s^oftit 

> 4-0^*0^5 ^-^*«*je-r*4-ia^«F^5y-^«»t»a (S24) 

©imb^? <«fc«) irzmtom&m'*? *-9&i&£wl (S2 6) 

m®;<7 J -*&&JEir ZA-®&®'<?*-?miE^® (S3 0, S200*>6 
S 2 0 8) > :&cktW<j:< tt>l!«l2^iE$n/2:f«ia^leI^©/^7^-^IC^ 

c>Titfia4-isi#^cD^w«-^-r^^iBi^^fit^^ cs 2 0, s 3 0 

©M (PSPU 2^{i^/ciSr^!|ia^y h 1 ©#M££g&$gg (#&£fifc 

«B1 0 0) Kfc^T, <!>tt< £k1ffiE±ftfclltfgBc0gl&fc. m&J) (M,&m\Z{± 

zmp) toBi^^-ri&^^T 2 ^ (^5 0*>j:ra6®(c^"r) . 'j?t£<t 
t>m& cs 2 2) lostx memscDttft (Bgui¥<fce&i£iyt) twiB&E 
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(S24), t*>frias«ici&bs nnfc*mfr%izQi< 

(S 2 6) > mmmto&®<Dm'< : ? t-snzm-jg, tummmt^mm 

^**IP»ttJ«^ifc3C¥« (S 2 8, S 1 0 Ot^&S 10 6), IftfB^IIl^o 

***4>ft< tiimamma mmmwti&&) fr&±\z-m& s n w 

~:*£&IE^£^|BJ2fc&/*5*-;*&jE#I8: (S 3 0, S 2 0 0*>£S 2 0 8) 

(BMCDBMHk«g^44iaMiMMtife£¥aC (S 2 0. S 8 0 0^t,S8 
1 4) «§j£l,fco 

»»K:lk**-ri=JHH-r*IWBR*JttH» (ffllZMP^tfflSS2 0 0, S 2 0, 

s 3 o 6) „ twimmi(totzimBUikwmmBUj> 

*©3fc£tt:flE (ZMPpentD^^W-r^M&iS^^^^ifeg^ffl^ (S 2 0, 

s 3 o 8) „ bbfti^ftzfttcm&m¥*5 s A>®%&&mK&~3^Tm 
tt^xb) zmmrsmirm**? (S2o, s 3 1 o) . 4>tt< 



WO 02/40224 



48 



PCT/JP01/10026 



. S2 0, S8 12, S 8 1 4) N b *>tfil&M.&iftiti±tt;VLm& 

(S 2 0, S 8 0 0*&S 8 1 4. 1 0 0) «t -5 (CfftJjELfc 

C 

2*©^ (SUSP V > ?) 2^m^Ltim^ma^y h<D&!gfkf&$iM: 

K*h£*- SfrOPSPcD ZMP (sfBS-J-SfPtt Z M P (ZMPpend) £ttrS-hf* 

©^i&^#-iirt , tc#m"r^fflispzMP»m¥g: (nzMPtttiH2 o o, s 2 
0, s s 0 6) „ k*>m%znto£ntcmmzMP tamzMP b^z^ & 

vz$tmirz®ftis^*TJix&{!Lmniii^® cs 2 0, S 8 0 8),^<k 
t>fra»ai s n^miLM^ TJio&A&mzm^^xffimmiLM^TJicDm 

A,mtiL&m^m as 20, s 3 1 0) , b&mfc&Bsztuz.® 

20, S312, S314o ±ff:tt«fe*«2 0 2), tfcSfffBi? 
) f*#»*&J«^fB: (S20, S300 7&>£S314. 2&&&fifcg& 10 0) .£4f 

mtotal/mb 4*Utllfct*&N lili2WZMPi:| 2 cD^&mfeet/mtoal £f| 

o o) icfcir^ mmmB<D&m\z.£->xft8i-rzmnj]bmii<i>Gjj 



WO 02/40224 



49 



PCT/JP01/10026 



»K*»a*R (PZMP»iai«2 0 0, S2 0, S 8 0 6) fc, ##<fcfctif 

iajrffi3ttfcP8BR^fcBfa^;*j (mibzmp) 4>tt< tt>fflfa±# 

©i&^^W^lll^SajS-rSIII^IB^^x^cD^ffig (glEJg-FZMP (ZMPpen 
d)) *^5tjfttt«IIEW^« (S20, S 3 0 8) i:, 

&iram£ cs 2 0, s 3 1 o ^^t^M^m^ti^m^m^rji 
m (Jr^tfcg^if 2 02, s 2 0, s 3 1 2, s 3 1 4) tfre>mf£znzwi 

X&frJlt, ifegjjc (S 2 2) (CCStk ffiEMJ!cD«yt CB8U&¥<£fI: 

ftl»«Ut) tllriB^K^Ofijt <gfg£l*K;tJ*iM&it (g«iSZMP«/Lit> ) 

0*ap<5>-^«ft»R cs 2 4) . tt,WE»*icisu % Buta^im 

'<5/-^«S?a (S26)> t9H«JBW*#©Wli^<5y-^Kai^*s w 
(S28, S 1 0 Oj^SS 1 0 6) . 1tnB4-l»*©'<7 * -^i:S^ 

£^110^5 y~*ti§FIE3M£ (S 3 0, S 2 0 O^SS 2 0 8). fccfctWS 

»t«-r44-ia**BfH»tt*s¥a: (S20. s3oo^s3 u) zmtLzm 

iZMP (ZMPfeet)«*&*BHm, £lT©*#*iifc"rc fc#SE* 



WO 02/40224 



50 



PCT/JPO1/10026 



J: tf&sfc 3 7 *M X tb & t\, 

j& P * t> t> ©ISHS©^^— ;* > h=mfeet * (ZMPfeet-xp) * (G-C * afeetz) 

* • • tfc3 6 

t 

«koT#a&£*v £fc$3 easmft^a^AtDitft^^ h Jt/afeetzti. afeet 
©X, Yfi5#£ 0 Lrt:'* * h )IX& 

afeet = (msup * d2(xsup) / dt2 + mswg * d2(xs wg) / dt2) / (msup + msw g> 

• • • & 3 7 

#WB £ P J; a K&JTT * C h k> m 5 , 
CfftB£P£K:jr*-*o 



WO 02/40224 



51 



PCT/JP01/10026 



hit, *n*ti<Dttm&mt&-r& 0 
titzm*fmm&frfi>M.Txmm k/j*©^ zwpfeet ^m^Lmmvxnnt^ 

Xtt*tmzmmzt£<*><D-c^ ZMPfeet t>WKfcgl=*fL.T*&Stfi*>^^^/j:So 
3) Kol>T«U 2) ©#&<££ fc£6KiE®f&K^<#£ 0 *fc2) 

ZMPfeet *>m&m\zttLxm*tmzmmzt*z> 0 

PSf£l*&©<fc?Kt££bT*>ii^o 
1 ) jeW3<Di3r5t©£ 

3) %*pmzmm®w&&mfebxh&\,\ &ti&¥-iz<<i—*/*&$%fevx*> 



WO 02/40224 



52 



PCT/JP01/10026 



n^mm^m^Biz-t^tcibiz, wait 1 &<&mm'> Kii-jg 

HZMP#> — ^ora. ^SJJKOWiaiS^{4gt^i^48-t?ct>WJHl 

k «fc o r^-r -sisscbs^^ o <zw y-tjisxtzmm btz ^ooismanz 

i63fci6© (*&Mfttt?fiflf<D) »ZMPJFfli#*t, ^®W^0BHB#tt^ 

ZMP«iEII[**a6*i:*caJM3B»*»co|^»^jt&*i*CV^<D-C. tMT 

Lts^ZvtzWijEisftZfr&X&Zo 

tf&> _LfSbfc£ 1 Omt&<D]&&(Dm 1 207a- • f- + - McfcHT t = 0 © 
bgiz&!g£®JE$t:{t&m.Ltz-t)< (SI 0), *Wo^T§IEifclig 



WO 02/40224 



53 



PCT/JP01/10026 



WO 02/40224 



54 



PCT/JP01/10026 



a. mfcm*¥*T*&jizmm*®&®<D'<7 tunicas < mmmmm 
? *mm.t s n m m^m. 



WO 02/40224 



55 



PCT/JP01/10026 



4 . 1MBAIBft#*#IM£*«F«*trC iff #©1518© 3 Sffim© 



WO 02/40224 



56 



PCT/JP01/10026 



e. ^/j:< b&mfcg.&zntz±&itm&m^x&!&&&j£?z&®&m^&^ 

£4t*. fcCt £ -f % WjZ&Wj n ^ «/ h ©^^^g 0 

a . tttmm&ommz «* ^ rsg^-r ^mta* bm.tio^xh^mmm.^^tm 
±.&®&®\z&&&?iz&m+zmi$&ij3w.ft^&b, b&mfc&m 



WO 02/40224 



57 



PCT/JP01/10026 



&¥&mm,friz— zkatzimmtoiz-wc-t s <* ? ic. 15124-©^©^^ 5 y - 
f . 4>#< t bmfc®mt$ntLA-m&®®'<5/-?izm^Tmfc*m&®<D 



WO 02/40224 



PCT/JP01/10026 



1/21 



o 




WO 02/40224 



PCT/JP01/10026 




WO 02/40224 



PCI7JP01/10026 



3/21 



26 



1/ 



£2 



ROM 



64 



54 



RAM 



66 



A/D 












- 













D/A 















44 



WO 02/40224 



PCT/JP01/10026 




WO 02/40224 



PCT/JP01/10026 



5/21 




£ # A A * CWH26) 



WO 02/40224 



PCT/JP01/10026 



6/21 

me 



1M¥ 



s«izmp 




flSPZMP (ZMPfeet) 



(ZMPpend) 




xb 



WO 02/40224 



PCT/JP01/10026 



7/21 

X 

I i 




WO 02/40224 



PCT/JP01/10026 



8/21 

3f£8g| 




WO 02/40224 



PCT/JP01/10026 



9/21 

S9 



ZMPpend = f (1) 

i i 



i 



-►t 



ZMPpend' = f (i-nAt) 



jflik 



nAt 



t 



WO 02/40224 



PCT/JP01/10026 



10/21 

^1 om 



ZMPpend 



i 


i 


zmp[ 


EH I 






► 


0. 






U M 

periodCi] 


P 


eriodB 


n] 



- 1 



WO 02/40224 



PCT/JP01/10026 



11/21 
1 1 



ZHPpend 




ZMPpend 



► t 



i 








zmp[i] 


















0 




k ► 








period [I] 



ZMPpend 
A 




zmp[l+1]-zmp[i] 



t 



periodCi] 



PCTYJP01/10026 



12/21 
1 2 



3 



10 



t = 0 



X 



S14 



S16 

s 



yes 



#*>ys? 



t = t +At 



t = 0 



LT 



S18 



J 



S22 



,S24 



■S26 



-S28 



S20 



S32 



WO 02/40224 



PCT/JP01/10026 




Hi 4H 




WO 02/40224 



PCT/JP01/10026 



14/21 
1 5 

Q ENTRY 

■S100 



if 



r 

S102 



104 



SI 06 



*SJIfcflST?fcSq-|;:«|*r-*-<& 



WO 02/40224 



PCT/JP01/10026 



16/21 
81 1 6M 













1 


1/ 




ZMPteJEfi 






i H 
















ISZMP 






! j k 






/ J 




4=1 


F ^ 






■* ^ 


^ i 





















WO 02/40224 



PCT/JP01/10026 



16/21 
1 7l 



( ENTRY 



G 



IT 



S200 



a=1 1 Ltzm&O Z M P^iEfilc ,fc -3 r$8ife-#-S 



_j-S202 



_j-S204 



»S3 5*J8l\TZMP«£iES<D£im<*a£jfc 
*>5 



,-S2' 



06 



Z M P teoEgT? B & Z M P / — * £0jE 



S208 



RETURN 



3 



WO 02/40224 



PCT/JP01/10026 



( ENTRY ) 



17/21 

f£ 1 8 SI 




J-S300 



J-S302 



S304 



S«Lttt&&£*«>« 



t<D§aiZMP (ZMPfeet ) 



-S306 



if 



S308 



8ta£3£fl3lvc#J:5Zjg^ZMP (ZMPpend) £|fWS 



.$310 



(ZMPpend) &iomiin : F&*p&.m£&m-fz> 



if 



S312 



H-S314 



RETURN 



J 



WO 02/40224 



PCT/JP01/10026 



18/21 




WO 02/40224 



PCT/JP01/10026 



19/21 

2 0 



fcUtJUttttm&g^lt (XO,VO)£<Kfc46«*-$ 



S400 



S402 



OO 



Wll3*£*:¥Jl'£mi*X (XO, VO) £±#<D*D8M*ilg£ LT 



if 



S404 



* Z>Rtzmz&Wi U *<D<»£ (Xe. Ve) t *S 



S406 



(errx.erry) = (XO. V0)-(Xo, Ve) 



LT 



S408 



1 



S410 



yes 




£S412 



(xo. vo) >fiffli=^[«fe«)*?]^flt®4i (xo+axo, vo) , <xo, vo+avo) * fttor 

6 J&fettKjfeft Lfcfi (Xe+AXel. Ve+ AVe1) , (Xe+AXe2, Ve+AVe2) 



(errx. erry) 2fc<DfcJ8JfH8« (XO. VO) 



S414 

LT 



ofQ] = XO + VO /oiO 



S416 



S418 



^ RETURN ) 



WO 02/40224 



PCT/JP01/10026 



20/21 

S2 1 



( ENTRY ) 



$500 



1 



oo 



S502 



iz s mwmmv<$®&®$ttnr&zkiz*'oX'$m&® 

&WCO±teVL&&m (Xe. Ve) «* & Ic<$*»&fifejft&q0 

[k]£3fcEt£JBl,*T#tf>£ 
qO[k] = Xe + Ve /wO 



errq = qO[k] - q" 



S504 



L 



S506 



yes 



errqA^^esSW ? 




(aiu gup-shafts') 



a= AaiLT* mi 6SO!Ste!cLfc#oT<Rg*lZMP/1 

^*fitir« -<bl^<fco X <5®&®feffiT!<»±te®.W&8. (Xe. 
Ve) * &|c&iSa&«taft#q1 tk]*^*ffll%T*to* 

qUk] = Xe + Ve /wO 



S508 



r = (qlfk] - qO[k])/Aa 



S510 



a = -errq/ri LfcteB-S^iSg^ZM P/< 



J" 



S512 



& ftfcffi i #1 Z M P / < $ — 
ZMP£*5Tr& 



7" 



S514 



C RETURN ) 



WO 02/40224 



PCT/JP01/10026 



21/21 

Jfc2 2B 




$2 3 HI 



INTERNATIONAL SEARCH REPORT 


International application No, j 
PCT/JP0 1/10026 j 


lilt •CI 7 B25J 5/00 

1 According to International Patent Classification QPC) or to both national classification and IPC ! 




1 Minimum documentation searched (classification system followed by classification symbols) " " 1 
I Int. CI B25J 5/00 1 


1 Dcxmnientation searched other than minimnm docwncntation to the extent that such documents are included in ma fields Marched " 1 

Jitsuyo Shinan Kbbo 1920-1998 Toroku Jitsuyo Shinan Ktoho 1994-2001 
1 Kbkal JitBuyo Shinan Kbho 1971-1998 


1 Elec&oiiic data base c<msu^ 




MENTS CONSIDERED TO BE RELEVANT 


1 Category* 


Citation of document, with indication, where appropriate, of me relevant passages 


Relevant to claim No. | 


I A 
1 A 


US 5355064 Al (Honda Giken Kogyo Kabushiki Kaisha) , 

11 October, 1994 (11.10.1994), 

Full text 

& OP 5-277968 A 

US 5404086 Al (Honda Giken Kogyo Kabushiki Kaisha) , 

04 April, 1995 (04.04.1995), 

Full text 

& JP 6-31668 A 


i-io ~H 

1-10 


1 LI Farther dociinients are listed in me ccnthiuatian of Box C. LJ See patent family annex. 




Uj» ZSuZS&taS^i ... . _ w con^ to Involve an invasive atep wbrolhe document fa 

1 toST^ referring to an oral disclosure, use, exhlbmod or other ccmbhiedwa<m^o w more other ^documeritt,«ooh 


1 12 February, 2002 (12.02.02) 


Date of mailing of the international search report f 
19 February, 2002 (19.02.02) 


1 Nome and mailing addzess of the ISA/ 

Japanese Patent Office 

I Facsimile No. 


Authorized officer I 
Telephone No. 1 



Form PCT/ISA/210 (second sheet) (My 1992) 



Bgggftfe SBSWI&#-5§- PCT/JP01/1O026 



a. »ra©jRi-*^»od« (mmn&m (ipo) 

Int. Cl f B 2 6 J 5/00 



B. 



Int. C I 7 B26J 5/0 0 



B3^aa^ffl0f^&® 19 20-19 9 8* 

B *B#58^9£r&&$8 1 971-1 998* 
B*43£&?Sft$fJ&&$l 1 9 94-2 00 1* 







BBS*!"© 


A 


US 535 5064 Al (Honda Giken Ko g 
yo Kabushiki Kaisha) 1 9 9 4. 10. 1 
1, ^fc&JP 5-27 7968 A 


1-10 


A 


US 5404086 Al (Honda Giken Kog 
yo Kabushiki Kaisha) 1 9 9 5. 04. 0 
4, £dt&J P6-31668A 


1-10 



rxj #KB§^«>«>5AKT?&or, S^3t»<o^T»M 

OjjfiSttXWii^SIfe^tJt*. bit,© fc «z> • 
f&J ^—rKJ-y h7r%V -ana 



12. 0 2. 0 2 


19.02.02 


R*m<&fV? (ISA/JP) 

iffi»flOO-891S- 
Kfc&=HtfflKfi»*B2=T B 4 # 3 -9- 


*S8#9- 03-3581-1101 1* 


8C 


9133 


9fil 3 3 2 4 



«StPCT/I SA/2 1 0 (g2*4-i>) (1 9 9 8*7J?) 



